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ABSTRACT 


The present work outlines a methodology of shape synthesis 
using the concept of intrinsic geometry, for the design ol 
two- dime nsional and three-dimensional curves. Using the concepts 
of intrinsic geometry the shape of a curve can be defined in terms 
oi intrinsic parameters such as curvature and torsion as < 
function of arc length. The method of shape synthesis proposet 
for two-dimensional curves consists of selecting the shape model 
defining the shape design variable and then evaluating the 
cartesian coordinates of the curve. It is assumed that the enc 
point coordinates as well as the tangents are specified. Th< 
shape model is conceived as a set of symmetric pair of continuous 
piecewise linear curvature segments, each segment being defined as 
a f unction of arc length. 

The shape design of a three dimensional curve is accomplishes 
by modeling it with the help of two planar curves. The firsi 
planar curve is the base of the helix defined in its intrinsic 
form as mentioned above. The second curve defined in the ske^ 
direction of the two tangents is the rise curve of the helix 
defined either as a cubically blended curve with a straight lin 
portion in between, or in its intrinsic form. Th 

three-dimensional curve is finally defined in parametric fori 
using arc length of the base curve as the parameter. 

The proposed method has been shown to be useful for designi n ; 
two-dimensional or three-dimensional path of a mobile robot or th 
trajectory of the manipulator arm. Finally an illustrativ 

example of the trajectory planning has been described in Chapte 
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CHAPTER 1 

INTRODUCTION 

The need for flexibility, improved productivity, better 
quality end lover production cost in industries has motivated the 
speedy growth of automation in manufacturing processes. Special 
purpose machines were the first step towards this automation. 
Development of NC and CNC machine tools was the next major event 
in automation in manufacturing processes. The developments which 
are now taking place in Robotics will ultimately usher in an era 
of automatic factories. 

An industrial robot is a multi-functional automatic 
computer— controlled mechanical manipulator capable of performing a 
variety of tasks through motions along several directions. Robot 
manipulators need to be controlled in efficient and effective ways 
to enable them to perform the multitude of complex tasks for which 
they are designed. So, trajectory planning and motion control has 
evolved as an important research area. 

1.1 Trajectory Planning in Robotics 

A systematic approach to the trajectory planning problem is 
to view the trajectory planner as a black box as shown in Figure 
1.1. The trajectory planner accepts the input variables which 
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satisfies the constraints at interpolation points. In this 

approach the constraint specification and the planning of 
trajectory are performed in the joint coordinates- Since no 
constraints are imposed on the manipulator hand, it is difficult 
to track the path the manipulator hand traverses, hence in this 
method the manipulator hand may hit obstacles with no prior 
warning. In the second approach the user explicitly specifies the 
path which the manipulator hand has to traverse by an analytical 
function, such as a straight line path in cartesian coordinates, 
and the trajectory planner determines the desired trajectory 
either in joint coordinates or in cartesian coordinates that 
approximate the path. 


Trajectory planning can 

be done 

either in joint- variable 

space or in the 

cartesian 

space. 

For 

joint- variable 

space 

planning, the time 

history of 

all the 

joint 

variables and 

their 


first two derivatives are planned to describe the desired motion 
of the manipulator. For cartesian space planning, the time 
history of manipulator hand's position, velocity, and acceleration 
are planned and the corresponding joint positions, velocities and 
accelerations are derived from the hands information. The 

joint- variable space planning has following three advantages 

# The trajectory planned is directly in terms of controlled 
variables. 

# Trajectory planning can be done in near real time 

# The joint trajectories are easier to plan. 
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The associated disadvantage is the difficulty in determining the 
locations of the various links and the hand during motion* a task 
that is usually required to guarantee obstacle avoidance along the 
trajectory. 

Joint Interpolated Trajectories: 

While planning joint interpolated trajectories the following 
considerations are of interest CFu* Gonzalez and Lee* 19B7>. 

<i>. When picking up an object* the motion of the hand must be 
directed away f rom an object, otherwise the hand may crash into 
the supporting surface of the object. 

Cii> If we specify a departure position Clift off point> along the 
normal vector to the surface out from the initial point and if we 
require the hand to pass through this position* we then have an 
admissible departure motion. If we further specify the time 
required to reach the position* we can also control the speed at 
which the object is to be lifted. 

<iii> The same set of lift-off requirements for the arm motion is 
also true for the set down point of the final position ot motion 
so that the correct approach direction can be obtained and 
controlled. 

<iv> From the above mentioned points we have four positions for 
each arm motion as shown in Figure 1.2.: initial* litt-oft* 

set-down and final. 

<v> Constraints: 

Ca> Initial position: velocity and acceleration are given and 
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are normally zero. 

Cb> Lift. -off position: continuous motion for intermediate 
points. 

Cc> Set-down position: same as lift-off position. 

<d> Final position: same as initial position. 

<vi> In addition to these constraints the extrema of all the Joint 
trajectories must be within the physical and geometric limits of 
each Joint. 

<vii> Initial and final trajectory segment times are based on the 
rate of approach of the hand to and from the surface and is some 
fixed constant based on the characteristics of the joint motor. 
The mid trajectory segment time is based on the maximum velocity 
and acceleration limits of the joints. The maximum of all the 
joint times is used to plan the trajectory in a synchronous 
manner. 

Based on the above points , a class of polynomial functions 
has to be selected such that the required joint position, velocity 


and acceleration 

constraints are 

satisfied. 

and the 

continuity 

of 

these 

variables 

is maintained 

over the 

entire 

time interval 

It ,tl 
o ( 

One approach to solve 

this problem is 

to specify 

a 


seventh-degree polynomial for each joint i. 


q ct> os a t 7 + a t tf + at 5 + a t 4 + a t 3 + a t 2 + a t + a Cl.l) 

L 7<S543ZiO 


where the unknown coefficients a. can be determined from the known 

j 
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position and continuity conditions. However* the use of such a 
high degree polynomial to interpolate the given knot points may 
not be satisfactory- An alternative approach is to split the 
entire joint trajectory into several segments, so that different 
interpolating polynomials of lower degree can be used to 
interpolate in each trajectory segment. There are different ways 
a joint trajectory can be split. The more common methods used are 
described below in brief. 

4- 3-4 Trajectory. Each joint has the following three trajectory 

segments: the first segment is a fourth-degree polynomial 

specifying the trajectory from the initial position to the 
lift-off position. The trajectory second is a third-degree 

polynomial specifying the trajectory from the lift-off position to 

the set-down position. The last segment is again a fourth-degree 
polynomial specifying the trajectory from the set-down position to 

final the position. The coefficients of these polynomials can be 

determined from the known position and continuity conditions. 

3-5-3 Trajectory. This is same as the 4-3-4 trajectory, but uses 
polynomials of different degrees for each segment: a third-degree 
polynomial for the first segment, a fifth-degree for the second 

segment and a third-degree polynomial for the last segment. 

5- Cubic Trajectory. The entire trajectory is divided into five 
segments, each being a cubic spline function of third-degree 
polynomial. 

Trajectory Planning in Cartesian Coordinates 
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Many a limes it. becomes necessary to plan the trajectory in 
cartesian coordinates. For eg. if a straight line path is 
required to be traced or if there are any obstacles in the work 
environment to be avoided, then it is not possible to specify 
these constraints in joint space. Two methods to plan the 
trajectory in cartesian space are described in brief. 

Incremental Interpolator If the path r is given then small 
intervals Ar\ are computed and then Aq. is calculated as Aq. * 

£J] 1 Ar In this method the errors get accumulated depending on 
the size of Ar . chosen. These errors have to be tracked and fed 
back bo the controller. In this method we have to take care at 
singularities and near singularities, since the inverse of the 
Jacobian CJ3 doesn't exists at singularities. 

Absolute Interpolator The motion from a position A to another 
position B is be expressed in terms of a “drive* 4 transform, DCt' 
which is a function of a normalized time t' as 

T (V) « C Ct') P DCt' > < lool T > _1 <1.2 

<5 B AB B 

where 

t' - t' e C0,1I 

t is the real time since the beginning of the motion. 

T is the total time for the traversal of the segment. 

At position A the real time is zero, t' is zero and D<t' > is a 4 x 4 
identity matrix and 


P - P D<1> 


BB AB 

which gives 


DC1) 


CP } 

AB 


P 

AB 


<1.3> 
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(Details are given by Paul [19793} 

1.2 Design of Planar and Spatial Curves 

A variety of techniques are available for geometric design of 
curves. A brief review of these techniques is presented in this 
section for both planar and spatial curves. A curve is 

two-dimensional if it lies entirely in a single plane. 

A curve may be represented as a collection of points or 

analytically by an equation or a set of equations. (Rogers and 
Adams) An analytical representation has several advantages. Some 
of these are precision, compact storage, ease of calculation of 
intermediate points and the properties of the curve such as slope 
and radius of curvature. 

Analytical representation of curves originally defined by 
points with some boundary conditions are frequently required. 
From a mathematical point of view, the problem of analytically 
defining a curve from a known set of data points is one of 

interpolation. A curve that passes through all known data points 
is said to fit the data. One common curve fitting technique is 
piece-wise polynomial approximation. This technique involves 

determining coefficients of a polynomial of some degree. The 
actual shape between the points depends on the degree of 
polynomial and the boundary conditions imposed on it. This 

technique is also used to plan the trajectories in joint space as 
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discussed in the previous section. 

Mathematically > either a parametric or non" parametric form is 
used to represent a curve. A non-parametric representation is 
either explicit or implicit. For a three dimensional space curve 
to be represented in its explicit non-parametric Form a set of* 
three equations 


X * X 

<1.4a> 

y * /Cx> 

C1.4b> 

z ■ #Cx> 

<1.4c> 


are required, but for a planar curve only y = /<x> is sufficient. 

In this form for each x- value only one y-value and z-value are 
obtained. Consequently closed or multiple- value curves cannot be 
represented explicitly. Implicit representations take the form 
/<x,y,z> * 0 and #<x,y,z> *= 0 for a three dimensional curve and 
simply /<x,y> * 0 for a two dimensional case, and do not have the 
limitation of representing multiple- value or closed curves. 

Both explicit and implicit non-parametric curve 

representations are axis- dependent. Thus, the choice of 

coordinate system affects the ease of use. For example, if in the 
chosen coordinate system, an infinite slope is required as a 
boundary condition, it cannot be directly used as a numerical 
boundary condition. 
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In parametric form of representation, each coordinate of a 
point on a curve is represented as a function of a single 
parameter. The position vector of a point on the curve is fixed 
by the value of the parameter. A parametric curve is expressed 


X * 

x<t> 

<1.5a> 

y * 

y<t) 

<1.5b) 

Z as 

z(t> 

<1.5c> 


where the parameter t varies over a given range t < t < t . For 
a two dimensional curve x « xCt > and y = y<t> are sufficient. 

The position vector of a point on the curve is then PCt> « 
[xCt>, yCt>, zCt>3 for 3-D and PC t> = ExCt>, y<t>3 for a 2-D 
curve. The parametric form is also suitable for representing 
closed and multiple- valued curves. The derivative on a 2-D curve 
in parametric form is represented by P* Cb) « tx' Ct), y # Cb>3 where 
# denotes the differentiation with respect to the parameter. The 
slope of the curve is 

d V „ dy/dt r C <16> 

dx dx/dt x' Ct> 

Study or literature shows that a wide variety of curve designing 
techniques are available using parametric form or representation. 
(Rogers and Adams, 1989>. 
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In t,he intrinsic form, a three— dimensional curve in general 
requires two equations A « AC&) and r - tCs) for its complete 
description, where A is the curvature, t is the torsion and s is 
the arc length. The variables in this form are the intrinsic 
properties of the curve, which carry some physical meaning 
associated with them. For a two-dimensional curve, a well defined 
normal exists. However, for a three-dimensional curve any vector 
perpendicular to the tangent vector t is a normal vector. If n 
denotes the principal normal then the direction is fixed by 


dt 

ds 


* A n 


<1.7> 


where A is the curvature of the curve. The vector product t <& n 
defines a third unit vector perpendicular to t and n known as the 
binormal b. In all further discussions the word normal will be 
used for principal normal. 


The planes through a given point on the curve which contain 
the vectors t and n, n and b, and b and t respectively are known 
as the osculating plane, the normal plane and the rectifying plane 
CFig 1.3>. In case of a planar curve, the osculating plane is the 

plane of curve and the binormal vector b is fixed thus «= 0 

fox* a plane curve. On the other hand, when the curve is not a 
planar one , the vector b is no longer constant and an 
understanding of the twisted nature of the curve requires the 
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Figure 1.3 Trihedron Showing Tangent, Normal and 
Binormal of a Three-dimensional Curve 
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evaluation of 


db 

ds 


and is given by 


db 

. - T n 


< 1 . 8 > 


Curvature A gives the idea of the rate of change of slope of 
the curve, in other* words the rate at which the curve deviates 
from the tangent at any point . Torsion r is that property of the 
curve which gives a third dimension to the curve in cartesian 
space, therefore r «= 0 for a planar curve. Arc length s is the 
length of the arc measured along the arc from a reference point. 
It should remembered that the variation of these intrinsic 
properties A and t as a function of arc length s gives flexibility 
to the design of curves. 


1.3 Literature Review 

Amongst the different branches of mathematics geometry is 
probably the most appealing to our intuition. Different branches 
of mathematics have evolved during the past few centuries. 
Differential geometry is one of them. It deals with the geometry 
of curves and surfaces studied by means of differential calculus. 
Serret-Frenet equations evolve from this branch of mathematics 
which form the basis of the present work. 


The works of JCanayama and Miyake C63, Kanayama and Hartman C7J, 
and Shahriar 1143 form an interesting section of the literature 
reviewed. The concepts of shape synthesis has been developed by 


I ntroductton 



15 


Nuibourne. Shariar has solved the problem of mapping lineai* 
curvature elements in the A-s plane into the cartesian space, 
vising -the Serret-Frenet equations- 

Kanayama and Miyake [63 in their vork had mentioned about the 
trajectory specification/'' generation, and solves the problem using 
clothoid curves, and proposes a real time vehicle command system. 

In their work the algorithm is not described and also the 
velocities and acceleration have not been worked out. The 

trajectory generation is in two-dimensional space only. 

Kanayama and Hartman C73 have taken up the problem of local 
path planning for autonomous vehicles. Two cost functions are 
defined; path curvature and derivative of path curvature. In this 
paper they use cubic spirals to solve the path planning problem. 

The resulting solutions are smoother than those obtained by using 
clothoid curves, but the computational complexity is comparatively 

higher. 

Hsia and Young C53 derive analytical expressions for 
curvature, torsion, and radius of osculating sphere of the point 
trajectory in three-dimensional kinematics. Corresponding to a 
design position they obtain the loci of points tracing straight 

lines, helical curves and spherical curves. 

Ryuth and Pennock C123 in this work propose an accurate method 
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of planning x^obot end effector trajectory. This method is based 
on the theory of ruled surface generated by a line fixed in the 
end effector, referred to as the tool line. The orientation of the 
end effector about the line is included in the analysis to 

completely describe the six degree- of- freedom motion of the end 
effector. Finally the linear and angular properties of the motion 
of the end effector are determined from the differential 

properties of the ruled surface, and utilized in the trajectory 
planning. j 

Ryuth and Pennock 113] in this work discuss the case where the 
ruled surface cannot be described by an explicit analytical 
f unction,then the ruled surface is expressed in terms of a single 
parameter. A curve generating technique is used to represent the 
ruled surface. The technique used in this paper is the Fergusson 
curve model,which generates trajectory passing through all the set 
points and maintaining the curvature continuity at each set point. 

1.4 Objectives and Scope of Present Work 

In the present work, a methodology of design for 

two-dimensional and three-dimensional curves, using the concept of 
Intrinsic geometry has been discussed. The objective of the 
problem is to manipulate the shape of the curve, using the shape 
design variables, satisfying the end position and tangent vector 
conditions, which are specified as input conditions. 
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The two types of shape models CS-C-S and C-S-C) proposed in 
the present work for two-dimensional shape design ensure G 2 
continuity. The models proposed in the intrinsic space are mapped 
into the cartesian space using the Serret-Frenet equations, which 
have been solved numerically. The approach proposed here uses 
linearly varying, continuous curvature elements. 

For three-dimensional curve design an alternative to 
Shahriar's pseudo- intrinsic approach CShahriar, 1990 which vises 
cubically blended curve for modeling the rise of the helix has 
been attempted. In this clothoid blending CG-S-G shape model for 
2-D curve design) is used to model the rise of helix. The 
algorithm for three-dimensional curve design is similar to that 
presented in Shahriar's Dissertation 1141 with some modifications. 

A potential application of the present work is in planning of 
manipulator trajectories and path planning of mobile robots 
<AGVs). It is worthwhile mentioning that the intrinsic properties 
can be directly associated with the parameters to be controlled 
{velocities and accelerations) while planning the trajectories. 
In the present work these parameters can be controlled directly 
and hence this approach can be used to plan the trajectories in 
cartesian space, with the advantage of being able to control the 
velocities and accelerations directly. 
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CHAPTER 2 

INTRINSIC GEOMETRY AND CURVE DESIGN 


2.1 Basic Concepts of Intrinsic Geometry 

This section introduces the different concepts of intrinsic 
geometry used for the design of curves. Geometric elements are 
represented by either parametric or non-parametric equations. For 
a plane curve, an explicit non-parametric equation takes the form 
y * /<x>, an implicit non parametric equation takes the form 
/Cx,y>*= 0. On the other hand, for a plane curve to be represented 
in the parametric form, a set of two equations x * xCuD, y — 
yCu>, with u as the parameter < u < u z > are necessary. 


In the intrinsic form, 1 a three-dimensional curve in general 
requires two equations A « ACs> and r - tCs> for its complete 
description, where A is the curvature, r is the torsion and s is 
the arc length. As opposed to the intrinsic form, neither of the 
above forms have the ability to control the intrinsic properties 
of a curve explicitly. If the intrinsic properties of a curve can 
be associated with some useful variables to be controlled, then 
the intrinsic shape synthesis becomes more attractive. 


For the case of a 2-D curve, r « 0. In this case, the second 
order Serret - Frenet equations can be solved for any given 
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function of A<s>. For the purpose of trajectory planning 
piecewise linear curvature functions are sufficient as explained 
in Chapter 1. Consequently ramp type continuous curvature 
functions for AXs) have been considered. 

2.1.1 Serret - Frenet equations 

Consider a Curve C as shown in Figure 2.1. Let r be the 
position vector of a generic point P and let s the arc length of P 
from a reference point A, be the parameter describing the curve as 
r<s>. The unit tangent vector, the curvature, the torsion, the 
normal, the binormal of the curve C at the point P are given as 
follows. 


t 


dt 

ds 


dn 

ds 


db 

ds 


b 


dr 

ds 


■ An 


-A t + r 


* -r n 


t ® n 


b 


C2.1) 


< 2 . 2 > 


C2.3> 


<2.4 > 


<2.5> 


where t is the unit tangent vector, n the unit normal vector, 
b is the unit binormal vector, A is the curvature, and t is the 
torsion. Equations <2.2>, C2.3> and <2.4> are known as the 
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formulae of Serret-Prenet CFaux and Pratt,, 1980). These equations 
are used as the basis of shape synthesis for the present work. 

^ a curve is planar then r ■ 0 and the above equations can 
be written down as follows. 


r *= 


x<s> 

yCs> 


< 2.6 > 


t 


dr 

ds 


and n.t = 0 


<2.7> 


dt 

ds 


dn 

ds 


*= A n 


* A t 


< 2.8 ) 


<2.9 ) 


The review of lit erature on 2-D and 3-D curves indicate that 
different mathematical strategies have been used to find the 
general solution of these curves using the above equations. The 
approach used in this study is discussed in the following section. 


2.1.2 Solution Approach for Two Dimensional Problems 

Let us consider the problem of defining a curve starting with 

a ooint P <x *v > in a two dimensional space CFig. 2.2>. Let us 
^ O D O 

also assume that the tangent directions at P^ has been specified 

as O , and the arc length from a reference point A as s . If A is 
o 

the curvature at any point P , then it is assumed that the 
variation of A as a function of arc length as the parameter, A * 
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shape of the curve. The problem of finding the cartesian 
coordinates x and y as functions of the arc length s as parameter 
can be solved by using Serret-Frenet equations C2.2> through 
^2-4). It should be remembered that the variation of intrinsic 
property curvature A gives flexibility to the shape synthesis 
CShahriar , 1990. 


To begin with let us rewrite the equation as follows: 



dx<s> 

~di 

dyCs> 

~ds 


Since n.t « 0, then 

_ dyCs) 
ds 

n m dx<s) 

ds 


C2.10> 


< 2.10 


On the other hand : 


dt 

ds 


d 2 x<s> 


ds 

d 2 yCs> 

ds 2 


< 2 . 12 > 


Substituting equations <2.10 and C2.12> in equation C2.2> yields: 
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d 2 x<s> 


dyCs) 

, 2 


ds 

ds 



.2 . v 

« 4Cs) 

dxCs) 

d y(s) 


ds 

ds 2 


— — 


Therefore, 



d 2 x 

ds 2 

+ ft<s> —— « 
ds 

0 



d 2 y 

ds 2 

- *Cs> - 

ds 

0 


where at s « s^, x * 

X o' y 

b y , 6 «® & . 
7 o o 



Let us assume that 

•ft.Cs> 

is defined as 

a piecewise 

of s. Let 

yj' b x' + iy' 



where 

, dr) 

*> m di~' 

x' 

b , and 

ds 

y' 

- 

ds 

The governing equations 

<2.14> and <2.15> 

can now 

follows. 

c v' y 

- i ft<s> <r)' > 

ss 0 


or 

r>' 1 

if ft<s>ds i©<S) 

e e ** e 



Intrinsic Ceometry and Curve DesLgn 


C2.13> 


<2.14> 


<2.155 


linear function 


C2.16> 


be written as 


<2.17> 


<2.18> 
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Separating the real and imaginary parts, we get 

dx 


ds 


■ cost ©Cs)l 


< 2 . 19 ) 


<*y 

ds 


sin! ©<s>] 


< 2 . 20 ) 


Integrating these equations with respect to the arc length s 
yie lds the parametric coordinates of the 2-D curve in terms of the 
intrinsic parameter s. 


xCs) * J cosE©<oOMo- + x q 


C2.21> 


y<s> * J sint©<o , )ldo’ + y Q 


< 2 . 22 ) 


where 


©<o) ■ J A<s)ds + © o 


<2.23) 


Equations (221) through <2.23) can bo solved by using 
numerical integration and for the cartesian coordinates *<s> and 
y<s) once the curvature function A< s) is known. 

2.2 Planar Curve Design: 

This section deals vith the design of planar curves for 
Unear curvature segments. Let us consider the problem of 
defining a curve passing through t»o points VW 

VvV in a plane ’ the tansent aneles P ° and P± belns 
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specified as and Q^. 

The above problem of designing a 2-D curve passing through 
two given points with their end tangents specified can be divided 
in the following steps 

<i>. For A as the curvature at any point P, the variation of A as 
a function of arc length is defined. This step involves shape 
model definition as it decides the geometry of the curve uniquely. 

<ii>. Shape model being defined, equations C2.21), <2.221 and 
<2.23> are solved simultaneously for the complete definition of 
the curve in cartesian space. 

2.2.1 Shape Models 

In this section the shape models considered for this study 
are described below. 

Straight line Ciothoid Straight line CS-C-S> Model: In S-C-S 
model the two end portion of the curve are straight lines and they 
are blended with a ciothoid pair Csymmetric cornu spirals!) in 
between. The piecewise linear and continuous curvature will be 
either of the following two types as in figure C2.3> and C2.4X 
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F'iC u r > e 2.3: S-G-S Shape Model with Positive change 
in tangent angle. 


ACs> 



Figure 2.4: S-C-S Shape Model with Negative change 
in tangent angle. 

Area of the triangle © represents the change in the tangent 
angle, therefore a triangle below the s-axis indicates a negative 
change in the tangent angle. Since we assume a symmetric nature 
of the curve at the blend the shape model uniquely defines the 
curve in cartesian space. 

Clothoid Straight line Clothoid <C-S-C> Model: In G-S-C model 
the two end portions of the curve are pairs of symmetric spirals 
and the middle portion is a straight line. The piecewisely linear 
curvature function is either one of the following four types as in 
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figures <2.5> to C2.8>. The areas of the triangles © and ©^ 
represents the change in tangent angle of the first and second 
Glothoid pairs respectively. 



Figure 2.5: C-S-C Shape Model with positive tangent 

angle change for both the Glothoid pairs. 



Figure 2.6: C-S-C Shape Model with positive tangent 
jang 1 p change for the first Glothoid 
pair and Negative for the second. 
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igure 2.7. C~S—C Sh^ape Model wit,h negative tangent 
angle change for the first Glothoid 
pair and positive for the second. 


Figure 2.8: G-S-C Shape Model with negative tangent 
angle change for both the Glothoid pairs. 


A triangle to the bottom indicates a negative change in the 
tangent angle. In both the shape models the slope of the straight 
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lines in the A-s plot, is called the sharpness X. 

Design Methodology for S-C-S Model: 

The input parameters are the position coordinates of the end 
points P o <x q , y Q >, >, the tangent angles 6 , e^,and X rf the 

desired sharpness. 

The first step is to find the point of intersection Q(x^,y^> 
of the two tangents vising the following expressions (Figure 2.9>. 


Cm x - m x > + (y - y > 

OO ii 1 O 

X 4 * - m ) 

o i 


(2.24 > 


and 


where 


Y «m(x - x ) + y 
4 o 4 o ■'o 


m ■ tan 6 and m « tan 6 , 

o o i i 

initial and final tangents. 


(2.25) 


the slopes of the 


Let X be the given sharpness, then over the arc length oi 
d 

the clothoid pair the variation of curvature and the sharpness 
will be as shown in figures (2.10> and (2.11>. 
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Figure 2.11: Variation of sharpness Vs. arc length 
for S-C-S model 

If s' is the total arc length of the clothoid pair which 
blends the two tangents and a * 6 ± “ © Q the area under the A-s 
curve * a. 

The area ex expressed in terms of A.^ and s' from the geometry 
of A-s plot is 


a 


X d S ' 


C2.25> 


or 


/ 


e - e 

i o 


<2-2<5> 


The expressions for the cartesian coordinates as derived 

earlier Cequaldons 2.21, 2.22 and 2.23> are 

s 

xCsO « ; cosW<o'>3dcy + x o 
s 

o 

s 

yCs> * J sinE<9<o03d<7 + y o 
s 

o 

ec o) « J A<s>ds + e o 
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Since A<s> is a linear function of s, we substitute A + X s 

O d 

for ACs> in the above equations. The equations for the cartesian 
coordinates in terms of X , A , B and t a dummy variable will be 

d O O 


s 

x - x + fcos [ X t 2 / 2 + A t + e ]dt <2.27> 

O J d DO 

O 


s 

y « y + fsin t X tV 2 + A t + 6 3dt <2.28> 

7 7 O J d o o 

o 

Since we also assume that the curve starts with zero 

curvature A « 0, and using suitable transformations for the 
o 

proper choice of coordinate system <Le.) rotating the axis so 
that the x^axis is coincident with the initial tangent we can 
write the following equations. 


x 

9 


x * JcosC x t 2 / 2>dt 
2 o 


y 


3 


S 2 
JsinC X rf t / 2>dt 

o 


<2.29 > 


<2.30) 


Let x - x be 'a' and y - y be equal to 'b' 

3 2 3 z 

From the geometry (Figure 2.9> Kcos^ + cos V «= x 

I 

x « a 
2 

Therefore 


a 

1 * — — — 

<COS0 + COS0 ) 
A ^ 


<2.31> 


where 1 is the exit distance of the clothoid pair. 


Now PCx 2 ,y z > can be 


calculated from the following expressions. 
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x ■ x - 1 cos<© > 

y, - y - i since > 

where 1 is given by eqn (2.31 } and QCx^,y^> by eqn 
<2.24 ) and eqn <2.25> 

Calculating all the unknowns the points on the curve at 
regular intervals of the parameter arc length s are calculated. 


«v 

► 


Design Methodology for C-S-C Model 

The input parameters again in this case are the position 
coordinates of the end points P Cx ,y >, P <x ,y >> the tangent 
angles 0^, ©^,and the desired sharpness. 


Let Q be the tangent angle made by the intermediate straight 

m 

line portion of the curve as shown in Figure 2.12. In this model 
one more assumption is made that the sharpness of the clothoid 
pairs at both the ends is same and al s o that they are symmetric 
within themselves. The following figure shows the cartesian 


output of a C-S-C shape model. 


From the same arguments done for the S-C-S model in the previous 
paragraphs 


6 

m 


e «= 

o 



or 


s « 2 
2 



<2.33> 
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By suitable coordinate transformations <i.e> rotating the 
axes system such that the x-axis coincides with the initial 
tangent, becomes equal to zero 


™ C2.34> 

similarly for the second clothoid pair also 

or 


C2.35> 


To compute the values of s^ and s g it is necessary to know 

the value of 6 before hand. This is computed iteratively as 

m 

follows. 

<i> Since there is no basis to guess the value of 6 , the initial 

m 

guess made is the one equal to the angle made by the line joining 
the Initial and final points. 

Cii) At this stage knowing the initial guess value of s z and 

s g are computed based on this value of 0^. Subsequently P 2 Cx z ,y z > 

and P <x , y > are also computed. 

3 9 3 

Ciii) The value of 6 will be updated to the value equal to the 

m 

angle made by the line joining P^Cx^, y^> and ^ a ^ x 3 *y 3 ^- 

Civ) Here the old value of Q is compared with the updated value 

m 

of e . If the difference is less than the acceptable limit then 
m 
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•the new value of 6 is finalized and is used for all further 

tn 

calculations . 

<v> If the difference is greater than the acceptable value then 
■ repeat step numbers CiD, CUD and <iv>. 

The initial guess for 6 can also be initialized to a 

Tn 

constant value, but if it differs largely from the actual value 
then it takes a large time to converge. With the initial guess as 
described above the algorithm converges quite faster. This 

initial guess also confirms for the shortest path only, even if 
any another solution exists. Once the value of calculated, 

the points on the curve are computed as follows. 

The values of s and s are computed from the expressions 

2 3 

C2.34> and C2.35). Subsequently by using the expressions <2-27> 
and <2.28> for cartesian coordinates the points on the curve are 
computed at regular and small intervals of the arc length. 


2.3 Planar Trajectory Design 

Trajectory planning involves the definition of time 
derivatives in addition to the definition of position vector 
itself. The problem will be completely solved when the 


dr 


UX' 

expressions for r, > 


d 2 r 




are known completely as a 


function of time, when either s or 
time. 


ds 

dt 


is given as a function 
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The expressions for velocity and acceleration can be written 
as follows. 

dr ^ ^ <2.36 > 


dr ds 


dt 


d 2 r 


dt 


dr fds' 

. 2 Idt 
ds v J 


ds dt 
2 


dr ds 


^ at . 2 


<2.37> 


To calculate the values of velocities and accelerations from 

ds 


the above expressions it is necessary to know 


dt 


and 


d 2 s 


dt' 


apriori. The variation of 
length is also required, 
expressions are used. 


,2 

.~T- and ° - r - as a function of arc 
ds , 2 

ds z 

For dr and d — the following 
ds .2 

ds 


x JcosCfiKoOld a + 


<2.38) 


y * JsinKK<? , )Jdo' + y^ 


<2.39 > 


Differentiating under the integral sign 


x 


dx 

ds 


cosCSCs)! 


<2.40) 


dy 

ds 


sint©<s)l 


<2.41) 


Again differentiating 


x' and y' with respect to s. 
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x' 


d x 
ds 2 


-sin©Cs> 


deCs> 

ds 


C2.42> 


-£lx_ 

ds 2 


cos©Cs> 


de<s> 

ds 


C2.43) 


Where 


a 

OC ©•> * jA<s>ds + 6 ^ 


C2.44) 


The related expressions for ACs), 0<s> and 6' <s> for the 
C-S-C model as in figure are given below. 



For s < s < s : 
o i 


A<s) = X s 

a 


x <* 

ec<?> “—^2 + e o > 0 o “ 0 30(1 ®' “ 


d9<s> 

ds 


« X s 
d 


For s < s £ s : 
± 2 


ACs> » X s + 2A 
a * 
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SC oO * 2A a - 

l 

~ \ <y 2 - 2A s 
Z d 1 ; 

e' « d *< s > 

ds 

* 2& - X s 

1 d 


For s z < s < s g : 


A<s> * 0 

0Cs> * A s and 6‘ * m o 

ii ds 


For s o < s < s : 
3 A 


ACs> ■ -X .s + X s 

d d 3 


6Ko> 


As + X Co - s ><s 

11 d 3 1 3 


Co + S 3> "1 

2 J 


6 ' 


dQCs> 

ds 


* X Cs 
d 


3 


S> 


For s < s < s : 

A S 


A<s> ■ X s - X s 

d d 5 


ec oo 


As + 

i i 



s >A 

3 A 


+ 


V 



s a 

5 



+ S S > 

A S 


6' 


d£Cs> 

ds 


X Cs - s ) 
d 5 


The expressions for rest, of the models can be written similarly 
with the required changes for the expressions of A<s>. 

. _ cr-O-S and C-S-C shape model 

Specific numerical examples oi 

- — i- 
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curve design of all the types discussed above cure discussed in 
Chapter 4. One example of trajectory planning for C-S-C shape 
model with ds/dt ■ constant is also considered in Chapter 4. 
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CHAPTER 3 


SPATIAL TRAJECTORY DESIGN 


3.1 Methodology of Three- dimensional Curve Design 

This section deals with the design of spatial curves. The 
problem could be stated as: Define a space curve passing through 
two points A and B CFig 3.1!); the two unit end tangent vectors at 
A and B being given as t^ and t^ respectively. 

The desired space curve is proposed to be a generalized helix 
having a base curve on the plane normal to the skew direction and 
a rise curve along the skew direction. The above stated problem 
can broadly be divided into the following three steps. 

<i> Design a two-dimensional curve in a plane perpendicular to the 
skew direction A' A' # CFig 3.1) containing t . 

A 

<ii> Design a 2-D curve for defining the rise of the helix C3-D 

cui've) as a function of the arc length of the base curve designed 
in step i. 

<iii> Using the definitions of these two curves a 3-D curve is 

defined as proposed below. 

Approach for 3-D Curve Design 

The design of 3-D curve is not done directly in the 

coordinate system in which the input data is given, which will be 
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Figure 3.1 A Schematic Diagram of Input Condition 
Distance, Skew Direction and Base Cum 
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further referred to as the global coordinate system. A local 

coordinate system 0^- UVW is constructed such that O is 

1 

coincident with C <Fig 3.1>. C is the point of intersection of 

the common normal to the tangents t and t and the tangent 

direction t A - U-axis is along the direction t , the V-axis is 

along the direction of the common normal A' -A' ' and the V-axis is 

such that W « U ® V. Let and be the projections of the end 

points A and B on the O-UV plane, and let m and m be the 

1 2 

projections of the unit tangent vectors t and t on UV plane. 

A B 

The angle that makes with is denoted by © where © = cos" 1 

<m .m >. At this stage it should be noted that the local 

1 2 

coordinate system O-UVW is selected as above for the reason that 
the unit tangent vectors and t^ are projected onto the UV plane 
with its full length, and there is no component of either t^ or t^ 
along the W-axis. This makes us more free to design the third 
dimension of the curve. Setting up the local coordinate system we 
proceed with the actual design of the curve in this coordinate 
system and then transfer back the points obtained in the local 
coordinate system to the global coordinate system. 

To begin with, it is necessary to define a planar curve with 

specified end coordinates and tangent vectors in the UV plane. 

The end points f or the base curve will be the projections of the 
points A and B on the UV plane, they are represented by Q ± and Q z - 
Similarly the end tangents will be the projections of t A and t fi on 
the UV plane, they are represented by and ny With this data a 
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base curve is constructed using the method proposed in Chapter 2. 
ib consists of a set, of linear curvature segments which will 
satisfy end point geometric constraints of the UV plane. 

Once the base curve is defined, it is necessary to describe 
the rise of the helix < along the W direction} as a function of 
arc length of the base curve Cdenoted by S # }. In other words, it 
is now necessary to define another curve in the W - S' plane. The 
two end points of this curve corresponding to points A and B are 
and CS >d> where d is the skew distance between t and t . 

A B A B 

Without loss of generality, it can be assumed that s = 0 and s = 

A B 

s where s is the total arc length of the base curve. Further 
more this rise curve tangents should be horizontal that is 
parallel to the S' axis. 

One can think of several different ways to conceive the 
geometry of this rise curve. This rise curve can again be modeled 
using the intrinsic geometry approach. Curvature continuity of 
the rise curve is also required to be maintained for C 2 continuity 
to be maintained in the 3-D helix designed, keeping this in mind 
the following two methods of modeling the rise curves are 
described below which are a compromise between the curvature 
continuity and computational complexity. 

# Clothoid Blended Curve CC-S-C shape model using intrinsic 
geometry). 

• Gubically Blended Curve. 
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Figure 3.3 Clothoid Blended Curve without e Straight Line Portion 
in between to Model the Rise of a 3-D Curve 
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Clothoid Blended Curve 

Figures 3.2 and 3.3 show the schematic concept of a clothoid 
blended curve. It consists of two pairs of clothoid segments at 
both the ends A and B, and a linear segment in the middle if 
possible as in Figure 3.2. The sharpness of these two clothoid 

pairs is also equal to the base curve sharpness, if a straight 
line portion in the middle is possible, or is the minimum 
sharpness without a straight line portion in between <Fig 4.3 >. 
The tangent angles at both the ends being zero, in other words 
both the tangents are horizontal, the rise curve is uniquely 
defined as C-S-C model, exactly on the lines of the C-S-C model 
discussed in Chapter 2. 

Though the cubically blended rise curve gives a very good 
control over the intrinsic properties of the curve, it is a 
computationally costly model, since the whole algorithm for C-S-C 
curve has to be repeated and in relating the base curve coordinate 
C'U and V) to the rise coordinate CW coordinate > we land up with 
solving of non-linear equation. 

Cubically Blended Curve 

This model differs from the above in the respect that the two 
ends are blended with Cubic Curves instead of clothoid pairs as in 
in clothoid blended curve. , A straight line portion is also kept 
in between invariably, with the curvature continuity being 
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"Figure 3.4 Cubically Blended Curve For Modelling the rise of 
Three-dimensional Curve 
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maintained (Figure 3.4). Consider* a cubic recjuired bo be designed 

between points A and G. This can be accomplished as follows. 

* 

Since we know the points B<d,s*>, the point CC ) is also 

z z 

known. Draw a line through C with a slope of tan<^>. 

Let the equation of the Cubic Curve be 

2 3 

r = a + au + au + a u C3.1> 

0 12 3 

0 < u < 1 

Now -the cubic curve has bo pass through bhe poinb A and should be 

tangential bo bhe S' -axis ab poinb A. Further, ab ibs obher end 

< 0 = 1 ), bhe cubic curve should have zero curvabure bo maintain bhe 

curvabure conbinuiby wibh bhe sbraighb line, and should be 

bangenbial bo bhe line passing bhrough C, having a slope ban<?0. 

The boundary condibions can be specified as: 

dr t 

Ci> End point condition. At u=Q, — = — = tk 03 

du o 

dr t 

<ii> End poinb bangenb condibions: Ab u=0, m Clc 0 


Ciii> End poinb bangenb condibions: Ab u = 1, 


dr 

du 


« Ck cos y 
1 


k sin yJ 
i 


T 


<iv> End poinb curvabure condition. Ab u=l. 


dr 

du 




d 2 r 

du 2 


0 


where k and k are constants bo be evaluated along wibh a , a > a 
o 1 0 12 


and a . 
a 


Let h be the height where the end point G of the cubic 
1 
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blends with the straight line segment. Solving the boundary 
condition equations tor the known coefficients we get. 


a s 0 

o 


a «= £k 01 T 
i o 


a *= -a 
2 1 


£ — <k cos y 

o 1 


k > _L- ck. sin y>1 T 

o 3 l 


k 

o 



d / 2 1 

tan ^ J 


k 

i 


3h 

i 

sin ^ 


^ > r o = *' an_1 f 1 

V S ^ 


Finally, the cubic curve AG is defined as: 

. 2 3 

r «= a u + a u + a u 

12 3 

It is appropriate to mention at this stage that for the 

complete definition of the cubic curve, proper choice of values of 

y and h have to be made so that all the constants can be 

i 

evaluated. The values y a Y + 4 and h * 0.25 d is moderately 

o 1 

a good choice. The equation of the straight line portion is 

#■ 

y « tan y + — — — ~ — (3.4) 

d* 

y tan r 
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It, should be noted that the curve HB can be defined in a 
similar way. The rise curve will now consist of four segments AG, 
GC, CH and HB. One can complete the points on the segments AG and 
GG according to the above procedure and the points on the segments 
GH and HB can be obtained using transformations of mirror 
reflections around W and S' axis. The cubically blended curve is 
definitely superior to the parabolically blended curve in terms of 
computational efficiency. It is difficult to exercise a direct 
control on the curvature A of the rise curve, hence the 3-D curve 
design approach using cubically blended curve model for the rise 
curve Cor the helix angle) can be called as Pseudo-intrinsic 
approach. 


Having defined the base curve and the rise curve, the next 
step would be to correlate these two curves to define the desired 
3-D curve. The U and V coordinates of the base are computed for 
small intervals of arc length, at this stage only the V coordinate 
is also computed for the cubic curve as follows. 


The y-coordinate of the rise curve will be the W coordinate 
of the 3-D curve. Since we know the curve length of the base curve 
which is x- coordinate of the rise curve, the portion to which this 
point, corresponds to in the rise curve can be easily found out 
<cubic or straight line portion}. Knowing this, the value ot u 
(if it lies in the cubic region) can be computed by Newton-Raphson 




•~3arv 



■JSC. too* * 
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method 

and subsequently ^substituting 

the 

value of u 

in 

the 

equation 

3.3 the y-coordinate 

of the rise 

curve corresponding 

to 

the base curve can be calculated. If 

it 

happens to lie 

in 

the 

straight 

line portion, then 

the value 

of y-coordinate 

can 

be 

directly 

computed f rom the 

equation 

3.4 

of the line. 

This 


procedure is repeated for ail the points on the curve. 

The shape design of the 3-D curve using the above approach 
can be presented in the form of a algorithm as below. 

Algorithm: 

Stepl: Read the values of the end positions and tangent 

vectors r * r , t and t 
a' b a b 

Check whether t * t = 1 

A B 

If yes then the points and the tangents and t^ 

form a plane. 

else find the skew distance d 
if skew distance d = 0 

design a planar curve using the methodology 

presented in Chapter 2. 
else Proceed to step 2. 

Step 2: Set up O^-UVW coordinate system. 

Step 3: Generate the base curve using the method presented in 
Chapter 2. 

Step 4: Generate the rise curve. 

Step 5: Design the space curve by combining step 3 and 4. 
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3.2 Spatial Trajectory Design 

As mentioned in Chapter 2 trajectory planning involves the 

definition of time histories of time derivatives of position 

{position and orientation> vector in addition to the position 

vector itself. Knowing the expressions for r it is also essential 

dr d 2 r 

to know the expressions f or —7 — and . It is essential to 

dt 

make a proper choice of the angles before one can define the 

orientation vector properly. The two angles chosen here are the 

tangent angle of the base curve represented by B and the tangent 

angle of the rise curve represented by ys. If s is the actual arc 

length of the 3-D curve and s' the arc length of the base curve of 

the corresponding point then, we can relate the first and second 

time derivatives of s and s' as follows. 

s = s' — — 
s 

- — can be assumed to be constant R and to be equal to the ratio 


s 


of the arc length of 3-D curve to the arc length of base curve, 
therefore 


ds ds' 

St ■ dir R 

and 

d s ^ d s ^ 

dt. 2 dt. 2 


Now 


dr 

dt. 


and 


— will be given by 
dt. 2 


dr dr ds , 

"dtT = ds' dt. f 


<3.5> 


C3.65 


C3.7> 
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d 

dt. 



dr- d 2 s 
‘ E ’ 


R 


C3.8> 


Knowing all t-he above berms on -the right- hand side of t-he 


equat-ions (3.7) and <3.8), t-he variat-ion of 


dr , d 2 r 


dt. 


and 


dt. 


as 


f unct-ions of s are calculat-ed. We also know t-he variat-ion of s as 

dr d 2 r 

a funct-ion of t-ime t-. From t-hese relat-ions —77— and can be 


dt. 


dt. 


expressed as funct-ions of t-ime t-. The x, y and z components of 
dr 


ds 


and — r will be: 


ds 


*= cost©Cs' >3 
ds 


dy_ 

ds' 


sin£0<s' >1 


d 2 x , .. d©<s' > 

= -sin OCs ) 


ds' 


ds' 


dy 

ds' 3 


= cos 6Cs ' > 


d(9<s' > 
__ 


where 


o 

e<oo » J Acs' yds 1 + © o 

o 


<3 .50 


<3.10> 


<3.11> 


<3-123 


<3.13) 


For t-he z-component we have two models of t-he rise curve, t-he 
clot-hoid and t-he cubic models. The expressions for each model are 
given separat-ely below. 
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# For clot. hold model 


dz 

■ tanly/Cs' >3 <3.14> 

where s' is the arc length of the rise curve in the w-s 
plane and y/<s' > is the tangent angle of the rise curve. 


similarly 


where 


d 2 z 


ds' 


sec Cy/Cs ' >3 


a 

y/<o0 «= f ££s' >ds' + y t 
J o 

o 


<3.15> 


C3.16> 


• For a cubic curve these equations are straight forward. The 
computational complexity with cubic blended rise curve is also 
very less. These equations for the cubic curve will take the form 
as follows: 


dw dw /d\A 

ds ' = ds ' /du 


<3.17> 


Again differentiating the above equation with respect to s' and 
simplifying we get 
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d 2 w 


ds' 


dw /du ds # 2 

ds ' /du _ 2 
du 

Cds'/du> 2 


,2 

d v 


du 


C3.18> 


The expressions for all the right* hand side “terms are known 

in a closed form and “they are quite simple to compute for 

,2 

different values of u which makes the calculation of — — quite 

ds' 2 

simple as compared to the above method. An illustrative example 
of 3-D trajectory planning for C-S-G shape model base curve and 
cubically blended rise curve, is considered in the next Chapter. 


3-3 Applications of Spatial Trajectory 

One of the most potential application is for planning the 
path of mobile robots Cor AGVs> where the motion is in 
three-dimensional space Cie> the platform of the robot has to move 
not only in a plane parallel to the ground but also has to take a 
lift in the direction perpendicular to the ground plane. These 
curves designed can also be used to plan the trajectory of the 
manipulator arm in cartesian space. 


The space curves are used to design the connecting road 
between the two highways or flyover where there is a difference of 
height at both the ends. The use of intrinsic geometry approach 
not only allows the designer to evaluate the parameters such as 
curvature explicitly, but also provides the flexibility to change 
the shape of the path fulfilling the end point conditions. This 
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can be achieved by choosing a different, shape model and also by 
altering the value of the sharpness X . 
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CHAPTER 4 


CASE STUDIES AND EXAMPLES 


4.1 Implementation Details 

The programs developed for the design of curves and the 
trajectory are all modular and interactive. The graphics hardware 
facility used for this purpose are a SUN — 3/60 workstation and 

the software infrastructural utilities such as the Sunview are 
used. The program is menu driven for input purposes and als o 
offers the choice of the final output to be viewed on the screen. 
All the modules have been written in *C' language. These programs 
can be ported on to any system with the required changes in the 
graphics module, which is implementation dependent. For the 

purpose of hard copy output AutoCAD has been used which uses the 
program output as input data. 

4.2 Examples of 2-D Curve Design 

As discussed in Chapter 2, two shape models for planar curves 
CS-C-S and C-S-C> are considered for this study. Specific 

numerical examples for both the models are discussed in this 
section with a typical example of each being considered for the 
time differentials of position vector, which makes the discussion 
on 2-D trajectory design complete in its sense. 
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To have an idea as to how the clothoid curve changes in size 

wit^h change in the given sharpness X^, "the cartesian output, of two 

clothoid curves Ccornu spirals) with X « 0.01 and X « 0.001 is 

d d 

shown in Figure 4.1. From these figures it is evident that as the 
value of X^ increases the curve becomes more sharp or the increase 
of curvature is fast 

Illustrative Examples of S-C-S Shape Model Curves 

Two types for S-C-S shape model curves have been discussed in 
Chapter 2. They are 

1. S-C-S shape model curve with positive change in tangent angle. 

2. S-C-S shape model curve with negative change in tangent angle. 

Figure 4.2 shows the cartesian space of the curves with 

different sharpness of X « 0.01, X « 0.001 and X *= 0.0002 for 

d d d 

S-C-S shape model with positive tangent angle change. It can be 

observed that as the value of the sharpness X decreases the exit 

d 

distance of the curve increases. The maximum exit- dist-ance is 

minC 1CP ,Q>, 1CP > as shown in Figure 2.9. If t-he value of 

o 1 

X specified is less t-han t-hat- value required for maximum dist-ance 
d 

then it is not possible to design a curve for that given value of 

X . In the program developed the user is prompted to make a 
d 

choice, either to reduce the value of X or to let the computer 

a 

find out the minimum value of X_, and design the curve. Figure 4.3 

a 

shows the curves again with the same sharpness and the end 
position vector conditions of P q ~ <25,25> and « C125,125> but 
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(25,25); 0 Q = 15 degrees 

(125,125); Q 1 = 70 degrees 



Figure 4.2 Example of S-C-S Shape Model Curve with 
Possitive Change in Tangent angle 


Casd Studies and Examples 


63 

t,he change in "tangent, angle in this case is negative. The end 

tangent, conditions are different, with 6 =70 degrees and 0=1^ 

° i 

degrees, the variation of values for \ is also same. 

d 

Illustrative Examples of C-S-C Shape Model Curves 

The different types of C-S-C shape model curves possible are 

1. Tangent angle change for the first clothoid pair is positive 

and that for the second clothoid pair is negative. 

2. Tangent angle change for the first clothoid pair is negative 

and that for the second clothoid pair is positive. 

3. Tangent angle change for both the clothoid pairs is positive. 

4. Tangent angle change for both the clothoid pairs is negative. 

Figure 4.4 shows C-S-C shape model curve in which the tangent 

angle change for the first clothoid pair is positive and for the 

second clothoid pair is negative. The end position vector 

conditions are kept the same for <ie> P * C25,25> and P = 

o i 

<125>125>, and the tangent angles are 0 ^ = 0 and B^ « 0 degrees. 

Three curves with different values of X * 0.01, X * 0.002 and X 

d d d 

5 = 0.0015 are shown. It can be observed that as the value of X 

d 

decreases the curve length increases and the curve deviates more 

and more f rom the straight line joining the two points. The slope 

of the intermediate straight line portion also increases with the 

decrease in the value of X . 

d 

Figure 4.5 shows an illustrative example of the C-S-C shape 
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Figure 4. 4 Example of C— S— C Shape Model Curve with 
Positive Change in Tangent angle for the 
First CLothoid Pair and Negative for Second 
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Y 

A 

P 0 = (25,125); 0 O = 90 degrees 
P 1 = (125,125); 0 1 =9O degrees 



_i i 

25.0 50.0 


1 1 >x 

75.0 100.0 125.0 


Figure 4.5 Example of C— S-C Shape Model Curve "With 
Negative Change in Tangent Angle For the 
First Clothoid Pair and Positive for the Second 
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model curve with the same end position vector conditions but 
different tangent angles B * 90 and & « 90 degrees. With these 

end tangent conditions the curve designed has a negative change in 
the tangent angle f or the first clothoid pair and positive for the 
second clothoid pair. For this case also the same variation of 
the sharpness X^ is shown. For both the above cases the net 
change in the tangent angle over whole of the curve is tzero and 
hence the change in tangent angle for the first clothoid pair is 
equal and opposite to that of the second clothoid pair. 


Figure 4.6 shows the example of C“S— C shape model curve in 

which the t an gent angle change for both the clothoid pairs is 

positive. The end point conditions are again kept the same with 

the end tangent conditions being changed to 6^ * 0 and 6^ * 90 

degrees. Unlike in the above two cases it is observed that the 

variation in the value of X does not affect the slope of the 

d 

intermediate straight, line portion, whereas the length of the 
curve increases as normal with the decrease in the sharpness . 


Figure 4.7 shows the example of G-S-G shape model curve in 

which the tangent angle change for both the clothoid pairs is 

negative. The end point conditions are again kept the same with 

the end tangent conditions being changed to © o = 90 and 9 = 0 

degrees. As in the above case it is observed that the variation 

in the value of X does not affect the slope of the intermediate 

d 

straight, line portion, whereas the length of the curve Increases 
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Figure 4.6 Example of C-S-C Shape Model Curve with 
Positive Change in Tangent angle for the 
for both the Clothoid Pairs 
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Figure 4.7 Example of C-S-C Shape Model Curve with 
Negative Change in Tangent Angle For the 
both the Clothoid Pairs 
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as normal with the decrease in the sharpness X . In these two 

d 

■types of models where the tangent angle change is either negative 

or positive tor both the clothoid pairs the, algorithm tor the 

calculation of the slope of intermediate straight line portion 

converges very fast. It can also be noted that the slope of the 

straight line portion in between is not a function of the 

sharpness X but depends only on the end tangent conditions. For 
a 

this model also there is a minimum value of X. . for which the 

d 

curve can be designed, if the value of X is further reduced then 

d 

the designed curve would make a loop which is not considered here. 
The algorithm described for calculating the slope of the 
intermediate straight line portion takes care for eliminating 
these cases where the curve makes a loop. The algorithm described 
for the design of C-S-C shape model curves takes care of all the 
four types depending on the input data. All the examples 

considered here are in the first quadrant only, if the input data 
given is in the other quadrants then the required transformation 
of the axis system has to be done at the appropriate place. The 
algorithm described takes care for these cases in other quadrants 
also. 


To make the discussion on trajectory planning complete it is 
necessary to know the variation of velocities and acceleration as 
a f unction of time. An example of the C~S~G model curve with 
positive change in tangent angle for the first clothoid pair and 
negative for the second, with the sharpness X d * .002 is 
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considered. One more input is required to plan the trajectory 
that is the speed vs. time relationship. Once this relationship 
is specified as a closed form function or some numerical discrete 
data points being provided we can now calculate dx/dt and dy/dt 
from equation <2.36>. To simplify the problem ds/dt is taken to 
be constant over the whole period of time. In the example the 
value of ds/dt is taken as 50 representative units. The velocity 
and acceleration plots for the x and y directions are shown in 
Figures <4.8> and <4.9>. This example where ds' /dt = constant can 
serve as a good model to plan the path of a mobile robot in 3-D 
when the robot platform travels at a constant speed all over the 
path length. 

4.3 Examples of 3-D Curve Design 

For a 3-D curve design the input variables are again the same 

<ie> P , P , t and t , but these are vectors of dimension 3 by 1, 
o' r o i 

the x, y and z components of these vectors have to be specified. 
For the example considered here P^ = <25, 25, 25>, P^ *= <125, 125, 
125>, t^ * <1, 0, 0> and t^ « <1, 1.713, G>, the value of \ d being 
equal to 0.002. These tangent vectors t^ and t^ are not the 
normalized vectors. The curve is designed on the lines discussed 
in Chapter 3. The base curve is modeled as a C-S-C shape model 
curve, to model the rise of the curve the cubically blended curve 
discussed in Chapter 3 has been used. Figure 4.10 shows the 
isometric view of the 3-D curve. Figure 4.11 shows the base curve 
in the U-V plane and the rise curve in the V-S' plane. As an 


C<x©«a Studies and Examples 





U - V Plane 


W 



Figure 4.11 Base Curve with C-S-C Shape Model and Rise 
Curve with Cubic Blending for the 3— D Curve 
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dz/dt 

A 



d 2 z/dt 2 



Figure 4.12 Velocity and Acceleration Plot 

of the Z-Coordinate, when the 
Rise Curve is Cubically Blended 
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example for “the trajectory planning problem, the same above 
problem is considered here. The value of ds'/dt taken is again 
assumed 50 representative units. For the base curve of this 3— D 
curve the change in tangent angle at both the clothoid pairs is 
different, and hence the maximum curvature for the clothoid pairs 
is different, consequently for ds/^dt « constant, the maximum 
accelerations will also be different at both the clothoid pairs 
unlike in the previous example for 2-D where the maximum 
accelerations are same. It can also be observed that a component 
of the x and y velocities remain at the end position. The 
velocity and acceleration plots are shown in Figure 4.13 and 4.14. 
The plots of z component of velocity and acceleration are shown in 
figure C4.12) it can be noted that the acceleration is not evenly 
distributed over the whole of the time period and this 

makes it shoot to higher values than in the clothoid blended 
curves. Moreover it is very difficult to control the maximum 
acceleration directly, where as in case of clothoid blending it 
can be directly controlled by controlling the curvature. This is 
the essence of the present work. 

4.4 Observations On Numerical Work 

The integrals <Fresnel Integrals} to be evaluated for 
calculating the cartesian coordinates are evaluated numerically at 
small intervals of the arc length s. Evaluation of this integral 
is the most compute intensive job in whole of the program. In the 
design of C-S-C shape model curve this has to be evaluated quite a 
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large number of times in the iterative procedure for calculating 
the tangent angle of the intermediate straight line portion. 

For the purpose of display of a 3-D curve points for 
isometric view, U-V plane and W-S' plane are computed using the 
appropriate transformation matrices. Care has to be taken while 
selecting the view point for the isometric view. The direction 

cosines of the line joining the initial and final points should 

not be the same or proportional to the view point coordinates, in 
which case the curve will always appear to be a closed curve. 

A number of plots has to be displayed for the complete 

information of the curve and the trajectory design C velocity and 

acceleration plots in the x y and z direction. 
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CHAPTER 5 

CONCLUSIONS 

5.1 Technical Summary 

A variety of parametric and non- parametric curve designing: 

techniques are available for the design of two-dimensional and 

three-dimensional curves. These techniques lack in controlling 

the intrinsic properties of curves directly. A methodology of 

shape design using intrinsic geometry has been proposed for 

two-dimensional and three-dimensional curves. Two shape models 

CS-C-S and C-S-C) have been proposed for the design of 

two-dimensional curves > using piece- wise linear and continuous 

2 

curvature elements which ensure C continuity of the curve in 
cartesian space. For the design of three-dimensional curves a 
pseudo- intrinsic method is discussed in which the 

three-dimensional curve is designed by combining the definitions 
of two planar curves, the base curve and the rise curve. The base 
curve is defined using the concepts of intrinsic geometry as 
above, and the rise curve is a cubically blended curve with a 
straight line portion in between the two end cubic portions or 
also it can be designed modeling it as a C-S-C shape model curve. 
The base curve is defined in a plane parallel to both the tangent 
directions and the rise curve in the direction parallel to the 
skew direction. Finally the three-dimensional curve is defined as 
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a parametric function of the base curve arc length s # . 

Conventional trajectory planning schemes generally 
"interpolate" or "approximate" the desired path by a class of 
polynomial functions or by some parametric curves, and generates a 
sequence of time based "control set points" for the control of 
manipulator arm, from the initial location to its destination. In 
these methods a direct control over the variables like velocity 
and acceleration is not possible. The curves designed using 
intrinsic geometry makes it is possible to exercise a control over 
the variables like velocity and acceleration. The intrinsic 

properties can be controlled directly when the curves are designed 
using the concepts of intrinsic geometry, these can be associated 
to the velocities and acceleration if these curves are made use of 
in planning the trajectories. This concept can be applied in 
planning the trajectories to overcome the short-coming of the 
conventional methods. 

5.2 Recommendations for Further Work 

Intrinsic geometry approach for design of curves requires 
mapping of data from the intrinsic space to the cartesian space. 
This mapping is accomplished through Serret-Frenet equations which 
are a set of coupled differential equations. In the present work 
linear curvature elements have been considered. To solve this we 
land up with the Fresnel integrals, which ax*e evaluated 
numerically. The series summation approach has been used to 
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evaluate these integrals, which makes it a compute intensive job. 
It is however desirable to develop a computationally efficient 
algorithm or procedure for the solution of Serrei-Frenet 
equations. Since the range of values required is not very large 
and normally required in the range t0,rr3 one can also make use of 
look- up tables at the cost of memory of the computer. 

In the present work the curvature function &<s> is assumed to 


be a 

set 

of 

contiguous 

linear curvature 

elements. Instead 

this 

work 

can 

be 

tried out 

using a set of 

cubic spirals. A 

cubic 

spiral 

is 

a curve whose 

tangent direction 

is described by a 

cubic 


function of path distance s. This approach is expected to give 
more smoother paths as compared to the one with linear curvature 
functions, at the cost of increased computational complexity 
(Kanayama and Hartman, 1988>. 
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